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EE. INTRODUCTION 


Position location of tactical elements in the Marine 
Corps in the past has relied upon the fact that these units 
had maps from which they could determine their position. 
Position determination is therefore highly dependent on the 
ability of an individual to correctly orient himself to the 
natural terrain surrounding him and locate this same terrain 
on the map. Once located, the requirement then exists to 
transmit position information via radio link to parent units. 
Meshed with the ground commander's problem of position 
location is the task of organizing and conducting support 
operations such as medical evacuation of wounded personnel, 
artillery, naval gunfire and air support. 

Using visual references it becomes difficult to accurately 
locate one's position when operating in mountainous terrain, 
in heavy vegetation, at night or in bad weather. And with 
the heavy volume of radio traffic experienced during battle, 
the probability of communicating to higher headquarters a 
unit's position or information about that position is reduced. 
As a result the support operations mentioned earlier are 
delayed because of detailed clearances required to ensure 
protection of friendly units whose position is not precisely 
known. 

The obstacles to position location suggested can and do 


arise in the conduct of actual operations, and for that 





reason, the Marine Corps has written specifications detailing 

a Position Location and Reporting System (PLRS) designed for 
tactical employment on the battlefield, [1]. The system as 
construed is to consist of a containerized master unit 
composed of a general purpose computer and communications 
control electronics. This unit is referred to as the Master 
mit. it is responsible for processing all range information 
inputs to the system, and displaying unit positions on a visual 
display with a variety of other information. 

The other units in the area are all portable, capable of 
being carried by a single man, vehicle, or aircraft. They 
are referred to as update or ranging units depending on their 
particular function at the time. When a unit's position is 
being improved, that unit is referred to as the "update" unit. 
All other units that are in contact with the update unit and 
are providing range measurements are "ranging" units. The 
frequency at which each unit is updated is specified according 
to its type. That is,aircraft traveling at much higher 
velocities than men will require updates more often if their 
tracking is to be accurate. 

Before a unit can be tracked and position estimates made, 
an initial estimate of position must be made. This process 
SErimvcialization is controlled by the master unit. Once a 
unit is initialized the computer systematically selects 
ranging units processing their associated range information as 
applicable. In processing range information a new position 
estimate and a measure of the uncertainty in the estimate is 


provided. 





While the processing of accumulated range information 
for an update unit appears to be straightforward, the 
difficulty lies in deciding which ranges to process so that 
the most accurate position estimates will be obtained. Range 
information is a measurement of the time required to send 
a Signal from the ranging unit to the update unit and back 
@gain plus some built in delays. 

While the measurement of times associated with the total 
time 1S quite accurate, it is still subject to the effects 
of noise therefore range is a noisy measurement. In addition 
the uncertainty of the ranging unit's position adds to the 
uncertainty of the measurement itself. Therefore the 
selection of a ranging unit to best update a particular unit 
becomes a very important factor in the position location 
problem. One would desire to use the ranging unit nearest 
the line of the major axis of error in the unit to be updated. 

The error ellipsoids of the "update" and "ranging" units 
and their relative geometry are analyzed and their influence 
on the tracking is portrayed in examples with maneuvering 


high speed aircraft and with stationary units. 
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If. POSITION LOCATING PROBLEM 

A. THE FILTER'S DYNAMIC MODEL 

OF AIRCRAFT UNITS 

First consider units in aircraft in a two dimensional 
space. The estimate that we seek in this problem is position 
(X,Y) and ATI LAST, (X,Y) . X and Y are calculated with 
respect to a relative grid at a point on the earth's surface. 
The altitude is the vertical height above the earth at that 
particular XY grid intersection, and is not utilized in this 
investigation. 


For tracking we may choose a fourth order state vector, 


(ae) 


KeK eX 


Writing the equations in linear state form results in 


x(k+1) ® x(k) + T w(k) (2) 


where 


¢ = (3) 


x 
The altitude tracking will be handled independently. 


tedk 








De : 
y 
T 0 
roo ; (4) 
0 ZT 
2 
0 T 


B, EXTENDED KALMAN FILTER 

The observable range 1S a nonlinear function of the 
states. So we must briefly look at how the nonlinearities 
can be handled in this type of problem. 

Consider a nonlinear discrete system of state and 


observation equations given by 


x(ktl) = £(x(k),k) + g(x(k) ,k) -w(k) (5) 


and 


Ae enectky, ki v(kK) (6) 


imeenese equations £, g and h are nonlinear functions of the 


aeaee Variables x, w(k) 1s plant excitation noise, and v(k) 


is measurement noise. The plant noise and measurement noise 


are assumed uncorrelated, zero-mean, and white. That is 














Elw(k) + w (3) ] 


Q'(k) 6. 


and 


E[v(k) + v'(3)] R(k) 6 


kj 
In order to apply the linear filter equations, (5) and 
(6) are expanded about the best estimate of the state at 


that time and only the first-order terms are kept. Equation 


(5) gives 
x(k+1) = (k) x(k) + [(k) + wk), CH) 
with 
af 
@$(k) = — : 
°X | x= (k) 


pamilarly Eq. (6) yields 


z(k) = H(k) x(k) + v(k) (8) 
where 
oh . 
H(k) = — - (9) 
9% | x=x" (Kk) 


x(k) is the estimated state value after the Reh measurement 


andes (Kk) is the predicted value of the state before the 


, th measurement. That is, 
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Pe x(k) ,k—-1) . (10) 
A state error vector is defined by 
x(k) = X(k) - x(k), 
and a predicted state error vector is defined by 
page= x'(k) = x(k) |. 
Bete covariance of state error matrix is defined by 
P(k) = E[k(k) «+ x (k)] , 


and the predicted covariance of state error matrix is given 


by 
t — tt eerpse 
Pees) eee ec) x ac) 
The state excitation matrix is given by 
T ft 
Q(k) = E[T(k) -w(k)-wo(k) -P° (k) J ’ 
and the measurement noise covariance matrix is 


R(k) = Elv(k) - vi (k)] . 
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The Kalman Filter equations are given by [2] 


P'(k+1) = 6(k)P(k)o"(k) + Q(k) (11) 
G(k) = P'(k)H"(k) (H(k)P'(k)H'(k) + R(k)]77> (12) 
P(k) = [I - G(k)H(k)] P!(k) (13) 
mck) = £(R 0-1) /k) (14) 
z'(k) = h(x! (k) ,k) . (15) 
x(k) = x'(k) + G(k) [z(k) - 2'(k)]. (16) 


The Q matrix serves not only to allow for maneuvering 
but also to account for any model inaccuracies. That is, 
any discrepancies between the true action of the physical 
system and its characterization by Eq. (7). For a filter 
which reaches steady-state conditions the Q also serves to 
prevent the gain matrix G(k) from approaching zero by always 
insuring uncertainty in the predicted covariance of error 
Weer ix P*(k). 

The observation equation is nonlinear in the states anc 


1s given by 


A= txtky>  y GR) “1 - 


] ey) 
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Equation (9) can. be used to give 


Seservation matrix. The result is 


H(k) = — 0 eC.) ae 0 | (18) 
x(k)* + y(k)? x(k) * + y(k)? 


In doing this, the recursive Kalman filter equations have 
been extended to cover the nonlinear case. The pseudo 
measurement matrix, H, must now be calculated from the position 
estimates at each time interval. 

The use of the Extended Kalman technique in tracking a 
unit as it moves through the area presents a unique problem. 
Because we are observing only the range, we can improve our 
estimate of location only along the direction of the range 
vector. That is, the uncertainty or error variance in location 
remains unchanged in cross-range. We must then choose another 
ranging unit nearby that will improve upon this cross range 
error. This however is done later at the next prescribed 
interval for update of the unit in question. 

The conclusion drawn from this observation is that it is 
critical that an algorithm be developed for selecting the 
best observations (ranging units) to process in the updating 
of a unit. It will be shown that this algorithm must be 
dependent on the physical geometry associated with the 
covariance error ellipses. It takes into consideration the 
error covariances associated with both the update and ranging 


Mats. 
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IfI. RANGE MEASUREMENT PROCESSING AND ERROR ELLIPSOIDS 


The position of each unit within the system is established 
with a degree of uncertainty about the estimate. This 
uncertainty is expressed in the covariance of error matrix, 
P, and represents the sigma squared error deviation about the 
estimate. The position diagonal terms (Pyy and P,3) of the 
covariance matrix represent the variances of the estimate in 
the XY coordinate directions. Their erence aye off diagonal 
terms (covariances) represent the degree of coupling and the 
orientation of the uncertainty in the XY plane. 

If the errors were normally distributed, there exists a 
rotated coordinate system such that in the new system the 
orthogonal position components are uncorrelated. This is 
equivalent to taking the exponent of the joint normal 
probability density function, and applying a coordinate 
transformation which eliminates the cross terms. 


The exponent (for zero-mean random variables) is 








x 2r XY 2 

s - : H 2 (19) 
6) O19} Oo 

x any, y 


When set equal to a constant, this curve, which is an ellipse, 
is a curve of constant probability. This ellipse does not 
have its major and minor axes aligned with the coordinate 


system however. By applying the transformation 
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<= x cos @ + y sin 6 (20) 


and 
y*" = y cos 8 - x sin 6 (21) 
with 
7 2 = tan sg (22) 
2 
O -o 
x yY 


the ellipse will be aligned with the x', y' axis and the 
resultant random variables will be uncorrelated. The new 


varlances in this system are calculated by 


2 Z 
2 Ose * oy cov (xy) 
t is 
= 2 = ean ion © CS) 
and 
mee s 
o 12 e x y _ cov(xy) (24) 
y 2 Sin 20 : 


This method of viewing the sample statistics provides insight 
into the filter performance because it shows the regions of 
high probability and their geometric relationships. The 

2 2 


values of ort and Os are referred to as the rotated 


error variances in the following section. 
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When a range measurement is made between two units, each 
with a different and independent error ellipse, the uncertainty 
of position along the range line connecting the two is improved 
for both units. In addition, it 1S sometimes possible to 
reduce the error of the axis orthogonal to the range line 
depending on the orientation of the error ellipse. 

To study the influence of the error ellipsoids of the 
ranging and update unit let us consider a static example. 

This model is synomymous with those used for foot soldiers. 

Measurement noise will be considered to come solely from 
the error variance of the ranging unit and vice versa when 
their roles interchanged. That is, at the same time the 
"update" unit is being updated, let us also update the 
"ranging" unit. The estimates of position and their error 
ellipsoids are shown in Fig. l. 

A projection of the error ellipsoid along the y-axis 
is given in Fig. 2. If one utilizes each as an observation 
to update the other, the resulting variance of both along 


the range line is given by 


where OF and d5 are BiSsstandancad deviations Of units 1 and 2 


in the range projection and 9 is the new updated standard 


new 
deviation for both units in the range projection (Ti), as 


is seen also in Fig. 2. 
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FIGURE 1. Error ellipsoids for two fixed units displaced 
along y-axis 15 KM 
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Projection of error ellipsoids to their x-y 
components and updated error ellipsoids after 
each unit ranges on the other 
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Thus the processing of an error free measurement between 
two units provides a better statistical description of both 
units along the range line. 

This discussion considered fixed units with no velocity 
and only in the XY plane. Central to the equations employed 
in the Kalman filter are equations calculating the gains and 
the error covariance matrix. By merely adding the component 
of the variance of the ranging unit along the range line to 
the measurement noise in the calculation of the Kalman gains, 
the Kalman filter reduces the covariance matrix of the update 
unit properly. 

The uncoupled error matrices and their directions are 


(from eqs. (22)-(24)) 


4 0 
Dau ae a. = See 
1 0 100 I 
and 
100 0 
P,' = Q@., = +30° 
2 5 ; 2 


After update the resulting covariances are (see Fig. 2) 


ea 2 i. Ls 
P, (new) = 
11.18 20246 
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and 


59.42 30,34 
P. (new) = 
Oe a4 20.46 


Their uncoupled equivalents 


Beicg 0 
P, ' (new) = ; 0, (new) —s— 34° 
0 28 
and 
Vo 0 
P.' (new) = : 0. (new) = 28.6° 
0 Se 
After ten updating operations 
By Oh 0202 
Py (new) = ; 
Cre 2 0.04 
14.52 0.06 
P.' (new) — 
. 06 0.04 
and their uncoupled equivalents 
5.34 0 
P, ‘ (new) = ’ 0, ' (new) = Oe? 
0 AAG, t8! 
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P.' = ; 6. ' (new) — O04 6 


In Fig. 3 we see the influence of the sequential 
updating of the units, One upon the other over ten 
observations. 

Note that the successive ranging in the y-direction 
Perec tively reduced the error variance in y and its 
projection in x due to the xy covariance. This was 
accomplished by assuming the measurement noise consists 
solely of the y component of the error variance of the 


Sener unit ranging upon it. 


24 





oC 
N 
a] 








Una te #2 
Sse 
Lo 
oO 
Unit ¢2 
oo“ eee wr ee 
Lo é 
LEE Oe 
Sate —— 
Sa , 
-Q12 -008 SSS See” 004 CCS 032 
44 oo 
J (a 
qe 
feo) 


FIGURE 3. Sequential updating of the units, one upon the 
other, over ten observations 
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IV. TRACKING AND MANEUVERING TARGETS 


fee 6 LHE CHOICE OF QO 

One more bie approach in designing a filter to accomodate 
maneuvers is to increase the random forcing excitation 
covariance, Q, until the filter adequately tracks the 
Meefoiated maneuvers. Normally this is done in a tracking 
Simulation program. The running filter error residual, 
otk) - x(k/k) ) appears to be a Bee wer ncieat or of effec- 


mreveness than either mean error 


k 
Mean Error = = J (x(3) - &(3/3)) 
jal 


Sietor that matter, error variance. Filter lag or bias as 
is best seen in the sign of the error, is lost in the 
squaring process for the variance. Also, the mean and 
varlance error entail an accumulation of all error from 
Start up to the present time. In a Simulation, a maneuver 
Maye Often not occur until well into a tracking run, and its 
effect may not appear as markedly in the mean error and error 
variance. A Monte Carlo simulation is often an effective 
design tool here. However, unless considerable engineering 
insight is used the resulting filter has been designed to 
handle the zero mean maneuver. That is, the filter will be 
designed against an ensemble of maneuvering tracks the mean 


of which is no maneuver at all. It appears that a more 
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successful procedure is to design against a highly probable 
worst case maneuver. The resulting filter should then be 
able to handle all possible contingencies, which is a 
necessary ingredient in most military systems. 

The price paid in having a rather high Q in a filter 
design is an increased degradation in filter performance due 
to the measurement noise variance, R. In this application 
the meaSurement noiSe 1S minimal. The important thing is 
to attempt range measurements along the axis of maximum 


mmbter Crror Variance as discussed in Section IIl. 


fee OLMULATION RESULTS 

An aircraft flying at Mach 1 follows a turn of radius 
10 KM. Ranging unit 1 is located at the seein. dobbs 
is placed at (10 KM, 19 KM). We have the below filter 


parameters for Figs. 4 through 11 are 


1 ioe 6 
0 1 0 0 
aor (oe. 
0 0 0 21y 
0.5 0 
_— il 0 
es 
0 il 


Za, 





and the initial conditions of 


1028 0 OO 0 
0 10% 9 0 
P(1/0) = a 
0 Oo pall 0 
0 0 0 10°77 
and 
0 
0.333 KM/S 
X(1) = X(1/0) Roun 
0 


In Fig. 4 we have the first attempt at the algorithm 
for choosing the ranging unit nearest the line generated 
from the major axis of error in the error ellipsoid of the 
tracker. It ranged solely on unit 2 and failed to follow 
eieeturn. Similarlyein Fig. 5, the filter ranged on unit 2 
Bemeche first half of the flight and on unit 1 for the 
second half. 

The evolution of the design of the filter is presented 
here so that the errors in the design process may help to 
give insight into the filter's performance. 

In Fig. 6 we see the beginning of proper functioning of 
the ranging algorithm (except on the last 20 observations). 
Note also that the covariance of excitation, Q, is insuf- 


ficient to follow the maneuver as is indicated by the bias 
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mmaethe filter track from the true track. Here we have 


7 -4 
qk SB Aes 52 10 
from 
a) Rea 
and 
elon S100: 0 0 
“Gsalies ean 0 0 
Q = : x 
0 0 oe econ * 
0 0 Gece ean 


In Fig. 7 the algorithm appears to be functioning 
properly and there is sufficient Q for the filter to follow 


the turn. Here we have 


147 =) 0225 


In Fig. 8 the filter was tested for its response to 
increasing the measurement noise (from Oa O20 PeKM to 
a O71 KM). It tracked well. However in Fig. 9, when 
the noise was again increased (oO. = 1 KM) the track was lost 


immediately. This gives one a ball-park indication of filter 


performance as the ranging observations are degraded. 
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Figure 10 shows the filter performance with the error 
ellipsoids superimposed at every fifth observation. It 
indicates a short malfunction of the switching algorithm 
when the track crosses the x-axis. This was corrected in 
Fig. ll. The error ellipsoids are expanded to twenty-five 
times their true value in order that they may be seen. 

In the appendix we have listed the computer simulation 


program with comments regarding its operation. 
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BEGURE 5. 


MeecGaLte lm eGirecular track at Mach 1 and radius 
10 KM. Filter ranging on unit #2 and unit #1 


during second half. 


x = true track, O = noise track, + = filter track 
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MmEGURE 6. Aircraft in circular track at Mach 1 and radius 
VOSKMS Al@orithm for choosing which ranging unit 
Womelnaqmeoorly in last third of flight (unit #1 
ranges solely on last 20 observations. A too low 
Q is indicated by the track bias. 

x = true track, O = noise track, + = filter track 
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Aircraft in circular track at Mach 1 and radius 
10 KM. 


Algorithm for choosing which ranging 
unit working. 


= 10 M. 


x = true track, 


a) = 


noise track, + 
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OQ sufficient to allow filter to 
adequately track the turning maneuver. 
noise = 


Measurement 
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FIGURE 8. Aircraft in circular track at Mach 1 and radius 
imc tcort thm £or choosing which ranging 
iim vonemids © Siliritetent to allow filter to 
adequately track the turning maneuver. 
Measurement noise = 100 M. 
Se—-etewemiaack, © = nose track, + = filter track 
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EOGURE 9, 


Aircraft in circular track at Mach 1 and radius 
iti alcdomitam Lorvehoosing which ranging 
Matiemvom@incem O Ssurricient to allow filter to 
adequately track the turning maneuver. Filter 
drops track. Measurement noise = 1] KM. 


x = true track, O = noise track, + = filter track 
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FEGURE 10. Aircraft in circular track at Mach 1 and radius 
of 10 KM. Error ellipsoids presented on every 
fifth observation. Measurement noise = 10 M. 
Switching algorithm fails on x-axis. Ellipses 
25 times true scale. 
eae ericetuack., © — morse Erack, + = filter track 
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FIGURE ll. Aircraft in circular track at Mach 1 and radius 
CP oat heehtinGge algorithm corrected. 
Ellipses 20 times true scale. 
x = true track, O = noise track, + = filter track 
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V. CONCLUSIONS 


The evolution of this filter design appears to have 
some merit. The maneuvering target can be tracked handily 
with adequate choice of Q. The filter operated well in all 
but impossible ranging noise situations. The real system 
has nce noise on the order of ten meters. The filter tracked 
well with a range noise sigma of one hundred meters. 

tivesalgorithm for choosing which unzt to link to for 
ranging is finally operating satisfactorily. In fact, this 
may be the real contribution of this work. Another possible 
benefit is the use of graphical presentation of the error 
ellipsoids in filter evaluation. They were most essential 
moire algorithm for choosing ranging links and in the Q 
evaluation. 

Still to be accomplished are: an initialization algorithm, 
a spurious data gating scheme and a track deletion logic. 


The latter two items may be dispatched readily by letting 


Gate(k) = 3 fag 7d) + R, 1 (k) 


and if a unit receives no range update. Within the gate 
for, say, Six update sequence times, then reinitialize and 
mer: OVEL, 

The rotation and reduction of the error ellipsoids (l.e. 
the filter error ee ees was most instructive and gave 


much insight into the performance of the filter. 
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